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© A servo motor controller for effecting a model 
reference speed control. An acceleration signal is 
derived from a speed signal .fed back from a servo 
motor based on differential or difference calculus, an 
^acceleration value of the servo motor (d) is es- 
timated relying on a reference model (2) of the 
O) speed control system utilizing a current instruction 
r>(T(s)) formed in the speed control loop, the cal- 
0> dilated acceleration is compared with an estimated 
W acceleration, and the current instruction (T(s)) is cor- 
rected depending upon the result of comparison. 
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SERVOMOTOR CONTROL APPARATUS 


Technical Held 

This invention relates to a servomotor control 
apparatus having improved characteristics, such as 
a frequency response characteristic. 


Background Art 

In servomotor velocity control, ordinarily it is so 
arranged that a velocity signal fed back from the 
servomotor is compared with a velocity command. 
Fig. 4 is a block diagram showing an example of 
such a conventional control system in a case 
where disturbances are neglected. In Rg. 4, a 
represents an integration term having an integration 
gain Ki , b a proportion term having a proportional 
gain K2. c a current amplification term of torque 
constant K T . and d a motor term which includes 
motor rotor inertia J M and a constant £ indicating 
toad inertia. Further, s represents an integration 
operator. 

With this velocity control system, the sum of 
the result of integrating an error signal between a 
velocity command V(s) and motor velocity W(s) by 
Ki/S of the integration term and the result of feed- 
ing back the motor velocity W(s) through the pro- 
portional gain K2 of the proportion term b is applied 
to the motor d as a torque command T(s) (current 
command). 

In such a velocity control system, a time delay 
develops in the response of the torque command 
T(s) owing to the integration term a, and instability 
occurs such as control system oscillation when the 
system gain is enlarged. More specifically, the 
system cannot quickly follow up rapid changes in 
the commanded velocity V(s), and oscillation is 
produced particularly when the motor is controlled 
to be brought to a stop. 


Disclosure of the Invention 

The present invention has been devised In 
order to solve the foregoing problems and its ob- 
ject is to provide a servomotor control apparatus in 
which frequency response is raised and velocity 
can be controlled stably by mitigating the effects of 
disturbances and fluctuations in load. 

In accordance with the invention, there can be 
provided a servomotor control apparatus having a 
velocity control loop which includes a control cri- 
terion model for performing standard model-type 
control with regard to a servomotor, comprising 
means for forming an acceleration signal by dif- 


ferentiating a velocity signal fed back from the 
motor, means for estimating an acceleration value 
of the servomotor using a current command output- 
ted by the velocity control loop, means for obtain- 
5 ing an error between the acceleration signal and 
the estimated acceleration value, and means for 
correcting the current command by the error sig- 
nal. 

Accordingly, the servomotor control apparatus 
10 of the present invention compares a computed 
acceleration and the estimated acceleration and 
enables the current command to be corrected in 
conformity with the results of the comparison to 
make possible stabilized velocity control. 

75 

Brief Descriptio n of the Drawings 

Fig. 1 is a block diagram illustrating an em* 
20 bodiment of the invention having a standard model- 
type velocity control loop, 

Rg. 2 is a block diagram of velocity control 
system which takes the effects of disturbances into 
account 

25 Rg. 3 is a block diagram for describing 

parallel-type model standard control, and 

Rg. 4 is a block diagram illustrating an ex- 
ample of a conventional velocity control loop. 


30 


Best Mode for Carrying Out the Invention 


An embodiment of the present invention will 
now be described in detail with reference to the 

35 drawings. 

Since model standard-type adaptive control is 
used in the present invention, the principle of con- 
trol will be described first. 

Rg. 3 is a block diagram illustrating an exam- 

40 pie of parallel-type model standard control. As 
shown in Rg. 3, a criterion model 2 is arranged in 
parallel with a controlled system 1, an adjustable 
gain 3 provided ahead of the controlled system 1 is 
corrected adaptively during operation of the con- 

45 trolled system 1 , and gain control is performed by 
an adaptive controller 4 in conformity with the 
output of an arithmetic unit 5 in such a manner that 
an output lour of the controlled system 1 will follow 
up an output lour of the criterion model 2. T RE f 

50 represents a command signal, and e denotes an 
error signal. Such model standard-type adaptive 
control is advantageous in that adaptive control of 
the control system can be performed with a quick 
response. 

Rg. 1 is a block diagram illustrating an em- 
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bodiment of the present invention. Portions iden- 
tical with those of Figs. 3 and 4 are designated by 
like reference characters and a description thereof 
is deleted. This embodiment of the invention hav- 
ing a model standard-type velocity control loop is 
characterized in that a coefficient a of the criterion 
model 2 of the velocity control system is set to a 
vaJue at which the cut-off frequency and damping 
coefficient of the velocity control bop will be made 
equal to what they are when a corrective gain 
coefficient K A = 0 holds, and in that corrective 
gain K A is provided as the adjustable gain 3. That 
is, along with the velocity feedback loop, an accel- 
eration feedback loop is formed by providing an 
arithmetic unit 6 having the differentiation operator 
s to differentiate the motor velocity W(s), accelera- 
tion is estimated by the criterion model 2 based on 
the current command T(s), and the acceleration is 
compared with the fed back acceleration signal by 
the arithmetic unit 5 to correct the current com- 
mand T(s). 

Described next will be a transfer function H(s), 
= W(s)/V(s) in the control loop of Fig. 1 . 

In Fig. 1, the relationship among a velocity 
command Vcmd [= V(s)], torque command T(s), 
corrective torque signal A(s) and motor velocity W- 
(s) is as follows: 

T(s) = (Ki/S)V(s) - {(K,/S) + K 2 }W(s) 

A(s) = K A {(aK^J M )T(s) - SW(s)} 

W(s) = [Kt/{SJ m (1 + 0)}]<T<s) + A(s)> 

The transfer function H(s) is as follows: 

H(s) = KtKi {1 + aK A Kyj M )/[{J M (1 + 0) + 

KtK a }S2 +KtK2 {1 + (aK A KT/J M )}S + K-rKi {1 t 

(aK A KT/J M )}] (1) 


(A) Regarding the transfer function Ho(s) when the 
corrective gain K A = 0 

This corresponds to the conventional example 
shown in Fig. 4, namely an arrangement in which 
there is no acceleration feedback system. Assum- 
ing that the transfer function H 0 (s) = W(s)/V(s), we 
have 

H0(s) = (KtKi)/{J m (1 + 0)& + KtKzS + KjK,} 
(2) 

Here the integration term a and proportion term 
b are adjusted in conformity with the load inertia 
ratio, so that we have 
Kt = (1 + 0o)K, o . Kz = (1 +0o)K2o 
where fo: constant corresponding to the load iner- 
tia ratio 

If the constant 0 indicating the load inertia is as 

follows: 

0 = 0o 

Eq. (2) can be expressed as follows: 

H0(s) = KtKi 0 /(1 + M{M1+fio)& +Kj(1 + 

/3o)KaoS + KtK 10 (1 + 0o)} 


= ^/(S 2 + 2t<*n$ + (3) 
where (KtK,o)/J m = c*n* (KiAWfeo 


2f«n. 


5 (B) Regarding the transfer function H(s) when the 
corrective gain * 0 and the coefficient a = 0 

Here system operation will be described when 
the conventional velocity feedback system is pro- 
70 vided solely with the acceleration feedback function 
shown in Fig. 1. Assuming that the transfer function 
is H(s) = W(syV(s). we have 

H(s) = (KtK,)/[{Jm(1 + 0) + KtK a }S2 +K t K 2 S + 
KrKt] (4) 

rs This indicates that, in comparison with Eq. (2), 
provision solely of acceleration feedback is equiv- 
alent to effecting a pseudo-increase in motor rotor 
inertia 

20 

(C) Regarding the transfer function H(s) when the 
corrective gain K A * 0 and the coefficient a * 0 

This corresponds to a case where model stan- 
25 dard control shown in Ftg. 1 is provided with accel- 
eration feedback. By making the criterion mode 
coefficient o equal to 1/(1 + 0). the behavior 
exhibited is the same as that in the conventional' 
velocity control system with respect to the velocity 
30 command, and the apparent motor rotor inertia is 
enlarged so that the system presents improved 
stability. That is, the transfer function H(s) becomes . 
as follows, where the substitution (oK-tAJm) = a is 
made in Eq. (1): 
35 H(s) = KtKi{1 + aK A )/[(J M (1 + 0) + KtK a }S 2 + 
{KtKzoO + 0a)(1 + K A a)S} + {KtKio(1 + 0o)V 

+ a'M}] 

Next, when Ka is decided in such a manner 
that KjKa/JmO + 0) = P holds, namely when the 
40 apparent rotor inertia becomes (1 + P) times larger, 
a becomes as follows from K^a - P 
a = 1/(1 + 0) 

Accordingly, the transfer function H(s) is 
H(s) = KtK, 0 (1 + 0o)(1 + P)/[Jm<1 + 0)0 + P)S 2 
45 + KtK2o(1 + /3o)(1 + P)S + KtKio(1 + j8o)(1 + 
P>] 

= {KtK, 0 (1 + J3o)}/[Jm(1 + 0)S 2 + K T K2o(1 + 
0o)S + K T Kio(1 + 0o)] (5) 

More specifically, by setting a to be equal to 

so 1/(1 + 0), Eq. (5) is such that the velocity loop 
exhibits the same behavior as when K A = 0 (the 
prior-art example) with respect to the velocity com- 
mand V(s), and the apparent motor rotor inertia 
becomes larger at the same time so that the ve- 

55 locity loop exhibits improved velocity control sys- 
tem stability. 

Fig. 2 is a block diagram of a velocity control 
system that takes the influence of disturbance into 


3 


5 


EP 0 329 796 A1 


6 


account Before investigating the effects of distur- 
bance, the influence of a change in inertia on the 
transfer function will be considered. 

(a) Influence of a fluctuation in load inertia 

Described first will be the influence of a fluc- 
tuation in inertia on the transfer function H(s) when 
the motor inertia coefficient 0 is represented by /3- 
(s). The transfer coefficient H(s) may be written as 
follows from Eq. (1): 

H(s) = KtKioO + « KaK1 + /3oK(Jm(1 + & (s)) + 
KtKaIS 2 + KtKsoO + 0o)(1 + K A or')S + KtKioO 
+ /9oX1 + a'y 

The influence of the fluctuation in inertia on the 
transfer function H(s) is evaluated by the following 
equation: 
{dH(sya0(s>} 

= {-KtKioO + aK^I + [{J„(1 + fi(s)) 
+ KtK^S 2 + KtKzoO + &>)(1 + K A a')S + 
KtKioO + j8o)0 + «Ka)F (6) 
rf K A = 0 holds, we have the following from Eq. 

(2): 

{dH 0 (s)/d/3(s)} 

= {-KtK ?0 (1 + A))JmS?/{Jm(1 + ^(SWS 2 +KtKzo- 
(1 + friS + KtKioO + A))} 2 (7) 

Next, the following is obtained from Eqs. (6), 

(7): 

G,(S) = {dH(syd«s)}/{dHo(syai9(s)} (8) 

If the coefficient a of the criterion model is 
made equal to 1/(1 + 0t), as mentioned earlier, 
then we will have the following since Ka = P(1 + 
tftjxfJ^Kr) 
K A a' = K A x (Kt/Jm)* 
* = PO * ^KJm^t)(Kt/J m ){1/(1 + *)} 
= P 

Though tf(s) fluctuates in the vicinity of t . we arrive 
at the following if the range of fluctuation is ne- 
glected and 1 + 0(s) ^ 1 + 0\ is assumed to 
hold: 
Gi(s) 

= {Jm(1 + tfiJS 2 + KtK2o(1 + 0o)S + KtKioO + 
j3o)} 2 x (1 + Py(1 + PWmO + * JS 2 + KtKzoO 
+ jS 0 )S + KtKio)0 + MY 
= 1/(1 + P) (9) 

Eq. (9) indicates that when the corrective gain K A is 
determined in such a manner that the motor rotor 
inertia becomes (1 + P) times larger and is deter- 
mined in such a manner tht the cut-off frequency 
and damping coefficient of the velocity control sys- 
tem become equal to what they will be at K A - 0, 
the influence of the change in bad interia upon the 
change in the velocity loop transfer function can be 
reduced to a value which is 1/(1 + P) times as 
much. 


(b) Influence of disturbance 

The influence of a variation in torque upon 
output velocity will now be considered on the basis 

5 of a transfer function for a case where a torque 
disturbance T 0 (s) is taken into account in Fig. 2. 

If it is assumed that a torque command T(s) = 
(K,/S)V(s) - {(Ki/S) + K 2 }W(s), a torque command 
signal A(s) = K a £(c*Kt/J m )T(s) - SW(s)} and a mo- 

to tor velocity W(s) = [1/{SJ«0 + 0)}]P"d(s) + 
Kt{T(s) + A(s)}], then the following equation will 
hold with regard to motor velocity W(s): 
W(s) = [1/{SJ M (1 + 0)}] x P*d(s) + Kt(T(s) + K A 
{(aKT/J M )T(s) - SW(s)}H (10) 

75 Solving Eq. (10) with regard to motor velocity 
W(s), we have 

W(s) = [KtKi 0 (1 + /9o)(1 + K A a')V(s) + STo(s)l 
/[{JmO + fi) + K A K T }S2 + KtK2o(1 + £o)(1 + 
K A a')S +K T Kto(1 + #0(1 + K A a')] (11) 
20 The manner in which the motor velocity W(s) varies 
due to a change in torque disturbance T D (s) will 
now be investigated based on the foregoing. Spe- 
cifically, we have 
{a>W(syaT D (s)} 

25 = S/[JmO + 0) + K A K T }S 2 + KtK 2 oO + #>)(1 + 
K A a')S + KtKioO + /3o)(1 + K A a)] (12) 
Letting W 0 (s) represent motor velocity when K A = 
0 prevails, we have 
Wo(s) 

30 = {KtKio(1 + /5o)V(s) + ST d (s)}/{JmO + ^S 2 + 
KtK 2 o(1 + fo)S + KtKioO + M} (13) 
Therefore, 
{dWofsyaTofs)} 

- To(sy{JM0 + /9)S 2 + KtK 20 (1 + /io)S + 
35 KtKioO + fo)} (14) 

Accordingly, we have the following from Eqs. (12), 

(14): 

Gro(s) 

« {dW(syar 0 (s)}/{dWo(sydT D (s)} 

40 ' {JmO + ^S 2 + K T K2o(1 + #>)S + KtK,o{1 + 
Po)} W + fi) + K A K T }S 2 + KtK2o(1 + /8o)(1 
+ K A a')S + KtK, 0 (1 + /3o)(1 + K A a')] (15) 

Accordingly, if the coefficient a of the criterion 
model is made equal to 1/(1 + fi) and K A = P(1 + 

45 /3)(Jm^Kt) holds, then we have 
£td(s) 

= {JmO + flS 2 + KtK2o(1 + 0o)S + KtKioO + 
M} '0 + P){Jm(1 + /3)S 2 + KtKzoO + 0o)S + 
KtKioO * M} 

50 = 1/(1 + P) (16) 

Eq. (9) indicates that when the corrective gain K A is 
determined in such a manner that the motor rotor 
" inertia becomes (1 + P) times larger and a is deter- 
mined in such a manner that the cut-off frequency 

55 and damping coefficient of the velocity control sys- 
tem become equal to what they are when K A - 0 
holds, the influence of the change in load interia - 
upon the change in the velocity loop transfer func- 
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tion can be reduced to a value which is 1/(1 + P) 
times as much. 

Though an embodiment of the invention has 
been described, the invention is not limited thereto 
but can be modified in various ways without de- 5 
parting from the scope of the claims. 


Industrial Applicability 

70 

The servomotor control apparatus of the 
present invention is such that the velocity control 
system of a servomotor is provided with a loop 
which forms an acceleration signal by differentiat- 
ing motor velocity, acceleration serving as a model rs 
criterion is specified using a current comand, this 
estimated value and an acceleration signal are 
compared and the current command is corrected. 
As a result, frequency response is improved and 
the influence of disturbance and torque variation 20 
can be diminished to make stable control possible. 


Claims 

25 

1. A servomotor control apparatus having a 
velocity control loop which includes a control cri- 
terion model for performing standard model-type 
control with regard to a servomotor, comprising: 

means for forming an acceleration signal by dif- 30 
ferentiating a velocity signal fed back from said 
motor 

means for estimating an acceleration value of the 
servomotor using a current command outputted by 
said velocity control loop; 35 
means for obtaining an error between said accel- 
eration signal and the estimated acceleration value; 
and 

means for correcting said current command by 
said error signal. 

2. A servomotor control apparatus according to 
claim 1, characterized in that a corrective gain is 
provided with respect to the error between said 
acceleration signal and the estimate acceleration 
value, an error signal being obtained by setting a 45 
corrective gain coefficient K A in conformity with a 
fluctuation in load inertia. 

3. A servomotor control apparatus according to 
claim 2, characterized in that the means for es- 
timating the acceleration value of said servomotor 50 
is such that the control criterion model is c^Kt/Jm) 
(where K T represents a torque constant and J M 
represents motor rotor inertia), the coefficient a 
being set to a value at which a cut-off frequency 

and damping coefficient of the velocity control loop 55 
will be made equal to what they are when the 
corrective gain coefficient Ka = 0 holds. 
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